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(57) Abstract: This invention relates to the field of Incrtial Navigation Systems (INS) and satellite navigation systems such as the 
Global Positioning System (GPS) and in particular relates to methods of integrating GPS and INS data in order to provide more 
accurate navigation solutions. The invention provides a method of improving the accuracy of a tightly coupled integrated INS and 
satellite radio navigation system in cases where the satellite navigation receiver has adaptive tracking loop band widths. 
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Adaptive GPS and INS Integration System 

This invention relates to the field of Inertial Navigation Systems (INS) and satellite 
positioning systems such as the Global Positioning System (GPS). In particular, this 
invention . relates to methods of integratingiNS andJaPS .data in order to provide more . 
accurate^iayigatioirsointionsz: 

An INS comprises a set of accelerometers and gyroscopes, known as an inertial 
measurement unit (1MU), together with a navigation equations processor, which 
integrates the IMU outputs to give the position, velocity and attitude. GPS consists of 
a constellation of satellites which transmit navigation data to a GPS receiver. User 
location can be derived from the signals received from four separate satellites. 
Together, INS and GPS form the core navigation systems of military aircraft and 
missiles. Note: although the term "GPS" is used throughout the skilled man will 
"apprecfate'^ navigation system ffiafwoiks along 

similar principles to GPS, e.g. Galileo. References to GPS should therefore be taken as 
meaning any satellite system that operates in a GPS-like manner. 

Integrating INS and GPS together provides a navigation solution which combines the 
long term accuracy of GPS with the continuity, high bandwidth and low noise of INS. 

There are four basic types of INS/GPS integration technique. An uncoupled system 
simply uses the GPS data to periodically reset the INS. This approach is crude and, 
hence, is rarely used. A loosely-coupled system compares the GPS navigation solution 
to that of the INS to estimate errors in both systems using a Kalman filter based 
algorithm (for more information on the Kalman filter algorithm see Applied Optimal 
Estimation by The Technical Staff of the Analytical Sciences Corporation, editor A 
Gelb, Massachusetts Institute of Technology Press (1974)) . A tightly-coupled system, 
is similar to the loosely-coupled system but uses the range and range rate data 
transmitted from each satellite tracked instead of the GPS navigation solution. Finally, 
a deep integration system combines the GPS receiver tracking functions and INS/GPS 
integration within a common Kalman filter. This requires the re-design of, amongst 
other things, the GPS receiver, which requires access to the GPS Receiver 
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Applications Module (GRAM), which is restricted by the US Government. Processor 
loads in a deep integration system are also high and so this system has a number of 
drawbacks. 

Both loosely-coupled- and -tightly-coupled-systems - are in common user~However, 



invention (for further information on GPS/INS integration see GPS/INS Integration, 
AGARD Lecture Series LS-207; Systems Implications and Innovative Applications of 
Satellite Navigation by RE Phillips and G T Schmidt). 

Each navigation satellite transmits carrier signals on two frequencies, known as LI 
and L2, each with a pseudo-random code modulated onto it. The GPS receiver will 
track the code and carrier components of each signal independently. Each receiver will 
therefore maintain two so-called tracking loops for each satellite signal. Range data 
(referred to as "pseudo-range" in GPS terminology) is derived from the code signal 
tracking loop and range-rate data (referred to as "pseudo-range rate") is derived from 
the carrier signal tracking loop. Li normal GPS operation, each carrier tracking loop is 
used to aid the corresponding code tracking loops. However, carrier tracking loops are 
more sensitive to interference and will lose lock at lower interference levels than code 
tracking loops. The position of the receiver can be derived from the pseudo-range 
information and the velocity of the receiver can be derived from the pseudo-range rate 
information. 

The responsiveness of a GPS receiver is affected by noise (e.g. from interference with 
the GPS signal) and also by high dynamic vehicle manoeuvres. The bandwidth of the 
tracking loops is a measure of the frequency with which the receiver outputs 
independent range and range rate measurements. High bandwidths enable a receiver to 
track the receiver location more quickly whereas low bandwidths provide greater 
resistance to interference. It is thus important to select bandwidths carefully in order to 
maintain satisfactory receiver performance. 
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In the military environment many GPS receivers are capable of adapting their tracking 
loop bandwidths in order to respond to changes in the level of vehicle motion and 
interference. 

In an integrated INS/GPS"(tightly coupled)~system the~pseudo-range and pseudo-range 



filter. In dual frequency receivers, the outputs from the LI and L2 tracking channels 
are combined prior to input to the Kalman filter in order to correct for ionosphere 
propagation delays. A reversionary mode is usually implemented whereby INS data 
aids the code tracking loop in the event that the carrier tracking loop loses lock and the 
GPS receiver is unable to derive range-rate data. 

The Kalman filter is an estimation technique which provides an estimate of the 
GPS/INS system errors. Part of the Kalman filter technique is the calculation of the so- 
called Kalman gain matrix (K$" wHcfi" relates the accuracy of the current measurement 
to that of the previous estimates of the system errors. In order to correctly calculate the 
measurement errors in the system the Kalman filter assumes that all measurements 
have time uncorrected measurement errors. Gelb defines the Kalman gain matrix (K*) 



matrix, R* is the measurement noise co variance and []' denotes the inverse of the 
matrix. 

In fact the errors in successive pseudo-range and pseudo range-rate data are correlated 
with correlation times inversely proportional to the tracking loop bandwidths. If this 
fact is not addressed then the Kalman filter becomes unstable, resulting in degraded 
estimates. Where the Kalman filter corrected INS data is used to aid GPS code 
tracking, a form of positive feedback can occur which eventually causes the GPS 
receiver to lose its tracking locks. The navigation solution cannot be resurrected from 
the INS data alone, where the corrected INS data is used to aid GPS, either because 
there is no stand alone INS solution or because the INS solution, if available, is not 
accurate enough. Therefore, where GPS receivers that do not have adaptive 
bandwidths are used, this problem is circumvented by ensuring that the Kalman filter 
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where H* is the measurement 
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updates its estimate of the measurement errors at an interval which is greater than the 
tracking loop measurement correlation time (of the order of.l second), i.e. the interval 
between iterations of the Kalman filter measurement update phase is chosen to be 
greater than the tracking loop measurement correlation time. Since different receivers 
4ise^iIfci ^uUja d gi-> g I ropdha nda adti ra it . is impftrt a rt iT sfegr^W - 
Kalman filter is correctly tuned to the appropriate tracking loop bandwidths. 

In cases where the receiver has adaptive tracking loop bandwidths tuning of the 
integration algorithm becomes more difficult. A common approach is to tune the 
algorithm to a relatively high bandwidth level and disable the Kalman filter 
measurement inputs when the tracking loop bandwidth drops below a threshold value. 
This is obviously not an ideal solution since measurement data is being discarded 
which will inevitably result in a less than optimum navigation solution. 

It is therefore an object of the present invention to provide a method of improving the 
accuracy of a tightly coupled integrated INS and satellite radio navigation system and 
to alleviate the above mentioned problems. 

Accordingly this invention provides a method of integrating inertial navigation system 
and satellite navigation system data in a tightly coupled architecture by means of a 
Kalman filter, the satellite navigation data being received on a receiver having 
adaptive tracking loop bandwidths, comprising 

i) monitoring the tracking loop bandwidths or modelling them as a 
function of the receiver measured signal to noise density ratio (c/no) 
outputs , and 

ii) varying the rate of response of the Kalman filter to measurements from 
the satellite navigation system in response to changes in the tracking 
loop bandwidths such that correlated measurement noise in the Kalman 
filter is avoided. 

It should be noted that the bandwidths of the tracking loops for different satellites are 
likely to vary independently of one another, particularly where a controlled radiation 
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pattern antenna (CRPA) is used. Therefore, the adaptive inertial/satellite navigation 
system integration algorithm should be capable of adapting the Kalman filter for each 
tracking loop. 

Where tKe^tiacking 'loop 'bandwidths are riot a direct output of the satellite receiver 
dley illay be niT OT^ :: fixmTih^ :: r eueivei nat;asmed ~sign al"Tb nofstT tiensity^ ^ 
The variation of the tracking loop bandwidth with measured (c/no) is different for each 
receiver design. It is therefore necessary either to obtain the information from the 
manufacturer or to infer it from laboratory testing of the receiver using a GPS signal 
simulator capable of generating interference. 

By adapting the Kalman filter to the tracking loop bandwidth the best use of the 
satellite data is made. There are a number of ways in which the filter can be adapted. 

The update- mtervaf~(iteration rate) of The Kalman- niter can -be vaned7~Below~ a" 
threshold bandwidth the interval between measurement updates from each tracking 
channel is varied in inverse proportion to the tracking channel bandwidth. Therefore 
for low bandwidths the iteration rate of the filter can be reduced As an alternative to 
this the measurement data can be averaged over the iteration interval provided the 
averaged measurement is treated as a single measurement for statistical purposes. 

Alternatively, the Kalman gain matrix can be weighted down in order to obtain a rate 
of response of Kalman filter estimates to measurements equivalent to that obtained by 
increasing the measurement update interval. In this variation of the invention the 
measurement update interval remains fixed for each measurement type - pseudo-range 
and pseudo range-rate. When the tracking loop bandwidth drops below a threshold 
value, to which the update interval is tuned, the Kalman gain matrix is weighted down 
to simulate increasing the measurement update interval. 

The weighting of the Kalman gain matrix can conveniently be achieved by multiplying 
it by the time between successive (correlated) measurements divided by the time 
between successive un-correlated measurements. 
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Weighting of the gain matrix can also be achieved by multiplying it by a suitable 
adaption matrix. If the Kalman gain matrix is represented as one n, column matrix for 
pseudo-range measurements and a second n^ column matrix for pseudo-range rate 
measurements, where n, is the number of satellites tracked, then each adaption 
mate&rAr is m - B r-Jt- n, diago n al matrix wfaer-eifl- 

i) for the elements of the pseudo-range adaption matrix 

Apidi " 1 for Blcxh > Bl_cot 

Apjdi = Bi^coi/Bl_cot for Blcoi < Bl_cot 

Apidj = 0 i ±j 

where Blcoi is the code tracking bandwidth of tracking channel 
i and Blcot is the threshold code tracking bandwidth for 

=adap;fea3rai^ 

ii) for the elements of the pseudo-range rate adaption matrix 

Arkii = 1 for B L- cAi > Bl^cat 

Arkii = Bl_caj/Bl_cat for Bl_CAi < Bl^cat 

Aridj = 0 i$j 

where B L _cAi is the carrier tracking bandwidth of tracking 
channel z and Bl_cat is the threshold carrier tracking bandwidth 
for adaption. 

A farther way of adapting the Kalman filter is to vary the measurement noise 
covariance, R, which is a quantity that is varied within the Kalman gain matrix. Either 
this can be done by multiplying it by the time between successive un-correlated 
measurements divided by the time between successive (correlated) measurements or 
by dividing by an adaption matrix analogous to that described above. In the latter case, 
this involves replacing R within the Kalman gain matrix, K*, with R* where R'=R/A. 
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An additional way of adapting the Kalman filter is to model the time correlated 
measurement noise explicitly, either as additional Kalman filter states or as correlated 
measurement noise using a Schmidt-Kalman filter with Uncertain parameters (for 
more information on t he Schm id t-Kalman filter algorithm see Stochas tic Processes 
zzxnd^iiterJngJniecu^ At:adenii t rPr es s-f^97-Q)) J[ Trt^fthent^se^ 

the correlated measurement noise estimate, jt, is modelled as a first order Markov 
process, i.e. 

dx _ x 
dt % t * 

where the correlation time, should be modelled as inversely proportional to the 
tracking loop bandwidths. 

-An^ei^c^imeB^ 

navigation data according to the present invention will now be described with 
reference to Figure 1 which depicts an adaptive tightly-coupled INS/GPS integrated 
navigation system. 

Turning to Figure 1, a tightly coupled INS/GPS integrated navigation system is shown. 
A GPS receiver 1 is connected to a Kalman filter 3. An INS 5 is connected to the 
Kalman filter 3 and also the GPS receiver 1. A Kalman gain re-weighting function 9 is 
connected to both the Kalman filter 3 and the GPS receiver 1 . 

In use, the GPS receiver 1 outputs pseudo-range and pseudo-range rate measurements 
2 to the Kalman filter 3. It is assumed that these pseudo-range and pseudo-range rate 
measurements have been combined from the individual LI and L2 frequency 
measurements to correct for ionosphere propagation delays. The receiver 1 also sends 
GPS broadcast navigation data 4 to the Kalman filter 3, which enables the satellite 
positions, velocities and clock offsets to be calculated. 

The INS 5 outputs position, velocity and attitude 6 measurements to the Kalman 
filter 3. The Kalman filter 3 (in a closed-loop architecture) sends corrections 7 back to 
the INS 5. These corrections comprise Kalman filter estimates of the INS position, 
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velocity, attitude and inertial instrument errors. The INS 5 uses these to correct its 
position, velocity and attitude solution and to correct the outputs of its constituent 
inertial sensors! INS position, velocity and attitude 8 outputs are also sent to the GPS 
receiver 1, wh ich uses them to aid the c ode t racking loops qfthose satellite signals for 
: wlridT=camer4T^^ 

The Kalman filter 3 comprises a standard tightly-coupled INS/GPS integration 
algorithm, with the exception that the Kalman gain, K, is re-weighted. The Kalman 
filter operates a standard system propagation (or prediction) cycle. It operates a 
standard measurement update cycle up to and including the calculation of the Kalman 
gain matrices. A Kalman gain re-weighting function 9 takes unweighted Kalman gain 
matrices 10 computed by the Kalman filter for the current set of pseudo-range 
measurements and the current set of pseudo-range rate measurements and multiplies 

weighted Kalman gain matrices 1 1 which are sent to the Kalman filter. The Kalman 
filter 3 then resumes the measurement update cycle using the re-weighted Kalman gain 
matrices. 

The Kalman gain re-weighting function 9 calculates the adaptation matrices, A, using 
the formulae presented above from the tracking loop bandwidths 12 output by the GPS 
receiver 1. Where the GPS receiver does not output tracking loop bandwidths, an 
empirical model is inserted between 1 and 9 to estimate the bandwidths 12 as a 
function of the receiver output (c/no) measurements. 
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Claims 

1. A method of integrating inertial navigation system and satellite navigation system 
data in a tightly coupled architecture by means of a Kalman filter, the satellite 
navigation 'datarbeing~ received^on - a~ receiver havirigT^a^ 

i) . monitoring the tracking loop bandwidths or modelling them as a 

function of the receiver measured signal to noise density ratio (c/no) 
outputs , and 

* 

ii) varying the rate of response of the Kalman filter to measurements from 
the satellite navigation system in response to changes in the tracking 
loop bandwidths such that correlated measurement noise in the Kalman 

£lter3aSSoiaeaSr 

2. A method as claimed in Claim 1 wherein the Kalman filter is varied for each 
tracking loop. 

3. A method as claimed in any preceding claim wherein the tracking loop band 
widths are calculated from the received signal to noise density ratio. 

4. A method as claimed in any preceding claim wherein the iteration rate of the 
Kalman filter is varied in inverse proportion to the tracking loop bandwidth. 

5. A method as claimed in any preceding claim wherein measurement data averaged 
is averaged over the iteration period. 

5. A method as claimed any of Claims 1 to 3 wherein the Kalman gain matrix is 
weighted by multiplying it by the time between successive measurements divided 
by the time between successive uncorrelated measurements. 

7. A method as claimed in any of Claims 1 to 3 wherein the Kalman gain matrix is 
represented as one n t column matrix for pseudo-range measurements and a second 
n, column matrix for pseudo-range rate measurements, where n, is the number of 
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satellites tracked, and is then weighted by an adaption matrix A, the adaption 
matrix being an n, x n, diagonal matrix where 

i) the elements of the pseudo-range adaption matrix are 

A ^jcii-^-1 — f ur Bfc-eoi<=-BfcreQT— 

Apjcii = Blj:oj7Blcot for Bi__coi < Bl_cot 

Apidj = 0 i ±j 

where Bl_cch is the code tracking bandwidth of tracking channel 
i and Blcot is the threshold code tracking bandwidth for 
adaption, and; 

ii) the elements of the pseudo-range rate adaption matrix are 

A rki f=T - ' "-^Sr " Bt^^Brj^ 1 

Arfdi = Bljcai/Bl_cat for Blcai < Blcat 

where Bl_cai is the carrier tracking bandwidth of tracking 
channel i and Bl_cat is the threshold carrier tracking bandwidth 
for adaption. 

7. A method as claimed in any of Claims 1 to 3 wherein the measurement noise 
covariance, R, is divided by an adaption matrix A as claimed in claim 6. 

8. A method as claimed in any of Claims 1 to 3 wherein the measurement noise 
covariance, R, is weighted by multiplying by the time between successive 
uncorrected measurements divided by the time between successive measurements. 

9. A method as claimed in any preceding claim wherein the satellite navigation 
system is a Global Positioning System. 

10. A method of integrating inertial navigation system and satellite navigation system 
data in a tightly coupled architecture by means of a Kalman filter, the satellite 
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navigation data being received on a receiver having adaptive tracking loop 
bandwidths, comprising 

i) monitoring the tracking loop bandwidths or modelling them as a 
function of the receiver measuredUignal to noise densityratio~(c/n P ) 
outputs , and 

ii) modelling the correlated measurement noise within the Kalman filter 
explicitly such that the assumed correlation time is varied in inverse 
proportion to the tracking loop bandwidths. 

11. A method as claimed in Claim 10 wherein the correlation time is varied 
independently for measurements from each tracking loop. 

calculated from the received signal to noise density ratio. 

13. A method as claimed in Claims 10 to 12 wherein the correlated measurement noise 
is estimated as Kalman filter states. 

14. A method as claimed in Claims 10 to 12 wherein the correlated measurement noise 
is modelled using a Schmidt-Kalman filter algorithm. 
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